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ABSTRACT 

In  i960  R.  E.  Kalman  introduced  a  least  squares  concept 
that  gives  optimal  estimates  for  the  state  of  some  dynamic 
systems.   Included  is  a  brief  historical  introduction 
leading  to  his  work,  a  summary  of  his  work,  and  the  applica- 
tion of  the  theory  to  the  sonobuoy  reference  system  used  on 
the  S3A  aircraft.   Also,  a  tutorial  development  of  certain 
quantities  used  in  the  filter  is  presented  in  appendixes 
A  and  B. 
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I.  INTRODUCTION 

Aircraft  launched  sonobuoys  form  an  important  and 
growing  role  in  ASW;  however,  it  is  necessary  to  know  the 
position  of  the  sonobuoys  to  fully  utilize  the  information 
they  transmit.   In  the  past,  accurate  positions  were  avail- 
able only  if  the  aircraft  flew  over  the  top  of  the  buoy  at 
low  altitudes.   For  a  large  buoy  pattern  such  a  method 
consumes  time  which  could  be  used  for  other  aspects  of  the 
mission.   The  Navy's  newest  ASW  aircraft,  the  S3A,  will 
use  a  unique  technique  called  the  Sonobuoy  Reference  System 
(SRS)  to  estimate  the  sonobuoy 's  location.   The  SRS  uses  an 
interferometry  principle  coupled  with  a  modern  digital  com- 
puter to  update  buoy  positions.   To  increase  the  accuracy 
of  the  estimated  position,  the  data  from  the  SRS  are  proc- 
essed through  a  Kalman  filter. 

■f   The  Kalman  filter  is  a  recent  advance  in  estimation 
theory  that  has  been  widely  used  in  the  aerospace  industry. 
The  term,  filter,  was  advanced  by  electrical  engineers  to 
describe  an  input-output  system.   The  Kalman  filter  was 
designed  as  a  linear  filter.   A  linear  filter  is  a  process 
which  converts  an  input  to  an  output  in  such  a  way  that  the 
output  resulting  from  two  simultaneous  inputs  is  the  addition 
of  the  two  corresponding  outputs  [1]. 

Historically,  estimation  theory  has  been  concerned  with 
estimating  the  values  of  system  parameters  based  on  some 
observation  of  the  system.   The  first  major  estimation 


technique  was  developed  Independently  by  A.  M.  Legendre  and 

K.  F.  Gauss.   Although  Legendre  published  his  results  in 

1806  while  Gauss  published  his  results  in  I809,  Gauss  is 

generally  credited  with  inventing  the  method  of  least  squares 

because  he  derived  the  method  from  fundamental  principles 

and  claimed  to  have  used  the  technique  to  determine  the 

parameters  describing  the  orbital  motion  of  celestial  bodies 

in  1795-   Gauss'  parameters  were  the  most  probable  value  of 

the  unknown  quantities  based  on  the  data  available.   His 

definition  of  most  probable  values  was; 

The  most  probable  value  of  the  desired  parameters  will 
be  that  in  which  the  sum  of  squares  of  the  differences  be- 
tween the  actually  observed  and  computed  values  multiplied 
by  numbers  that  measure  the  degree  of  precision  is  a  mini- 
mum [  2  ] . 

Following  Gauss'  book  there  was  a  long  period  where  least 
squares  was  the  only  widely  accepted  method  for  estimation. 

In  1912  R.  A.  Fisher  published  the  method  of  maximum 
likelihood  and  thereby  established  the  present  theoretical 
background  for  estimation  theory  [3].   Maximum  likelihood 
estimation  is  cast  in  probability  theory  which  requires 
information  on  the  probability  distribution  describing  the 
object  being  measured.   For  an  important  class  of  problems, 
there  is  a  direct  correspondence  between  the  maximum  like- 
lihood and  the  least  squares  methods.   Assuming  the  object 
being  observed  can  be  described  by  a  gaussian  distribution, 
the  two  theories  give  identical  results  for  the  respective 
estimators . 


Following  Fisher's  work  there  was  considerable  effort 
in  the  field  of  communications  to  eliminate  random  noise 
from  the  signal.   A.  N.  Kolmogorov  and  N.  Wiener,  in  19^1 
and  19^2,  independently  developed  a  linear  minimum  mean- 
square  theory  that  provided  the  best  separation  of  signal 
and  noise  [4,5].   The  Wiener-Kolmogorov  theory  is  a  least 
squares  process  which  differs  from  Gauss'  theory  primarily 
in  that  it  allows  the  signal  to  vary  with  time  with  known 
statistical  qualities  and  the  filter  is  required  to  be 
linear.   The  main  problem  associated  with  their  filter  is 
the  difficulty  in  calculating  the  required  parameters  espe- 
cially for  a  complex  system.   Their  results  formed  the 
basis  for  the  subsequent  work  of  R.  E.  Kalman. 


II.   KALMAN  THEORY 

Kalman's  first  paper  on  his  filter  theory  was  published 
in  i960  [6].   A  summary  of  his  results  follows  in  a  discrete 
time  version  which  is  the  form  used  by  the  SRS.   Notation 
used  in  this  paper  and  appendixes  is;  capital  letters  and 
small  letters  represent  vectors  or  matrices  and  their 
components,  respectively,  subscripts  refer  to  the  time 
period  being  considered,  carets  indicate  values  that  have 
been  extrapolated  through  time  and  bars  indicate  that  the 
values  have  been  smoothed  or  weighted  by  some  measurement 
information.   The  equations,  describing  the  system  being 
observed,  must  be  of  the  form 

%  =  *i,i-A-i  +  "r  (1) 

X.  is  a  nxl  vector  that  describes  the  state  of  the  system 
at  time  i.   Each  component  of  X.  is  a  state  variable;  there- 
fore, X.  is  called  the  state  vector.  $.  .  ,  is  a  nxn  tran- 
sition  matrix  that  determines  how  the  system  propagates 

from  time  i-1  to  i.   U.  is  a  nxl  vector  that  is  a  gaussian 

1  ^ 

random  process  which  represents  the  uncertainties  of  the 
state  equations  in  describing  the  true  state.   The  statis- 
tical properties  of  U.  are 

E[U^]  =  0       for  all  i,  (2) 

ECUj^U^"^]  =  0    for  i  ?^  j  ,  (3) 

EEU^U^"^]  =  Vy   for  all  i.  (4) 


System  observations  are  given  by 

^i  "  ^i^i  "^  ^i  ^^^ 

Z.  is  a  pxl  (p  <_  n)  observation  vector.   Each  component  of 
Z.  is  an  observation  on  the  system  at  time  i  that  is  related 
to  the  state  variables  through  M. ,  a  pxn  measurement  matrix. 
Kalman  theory  requires  M.  to  be  such  that  the  observations 

are  linear  combinations  of  the  state  variables.   W.  is  a 

1 

pxl  vector  that  is  a  gaussian  random  process  which  represents 
the  uncertainties  of  the  measuring  processes  at  time  i. 
The  statistical  properties  of  W.  are 

E[W.]  =  0  for  all  i,  (6) 

E[W^W^.^]  =  0       for  i  5^  j,  (7) 

E[W.W.'^]  =  v.,      for  all  i.  (8) 

1  1  -^     W. 

1 

In  addition,  U  and  W  are  assumed  independent  therefore, 

E[W  U^]  =  0       for  all  i,j.  (9) 

Kalman  proposed  to  estimate  the  state  X.  from  the  last 

estimate  X.  .,  and  the  observation  Z.  in  such  a  way  as  to 
1-1  1  '^ 

minimize  the  mean-square  error  in  the  estimate.   That  is, 
E[(X^-X.)2]  (10) 

is  to  be  minimized.   The  solution  to  this  problem  has  become 
known  as  the  Kalman  filter.   The  optimal  estimate  of  the 
state  at  time  i  is 


X^  =  X^  +  Kj_[Z^  -  M^X^]  (11) 


where     X^  =  $^  i-i^i_i  •  ^^^^ 


The  gain  matrix  K,  is  determined  by 


Kj,  =  C^M^'^CM^C^M^^  +  V^^]  (13) 

where     S,  =  ^i,i_iC. ^,_,.^^ . .^  +  V^^_^  (l4) 

and       C,_,  =  5^_,  -  K,_,M._^5._^  (15) 


where  C.  is  the  nxn  covariance  matrix  of  the  state  variables 
In  words,  the  optimal  estimate  of  X.  is  the  optimal  estimate 
at  time  i-1  propagated  to  time  i  and  then  modified  by  the 
weighting  matrix  K.  times  the  difference  betv/een  the  actual 
observation  at  time  i  and  the  estimated  value  of  the  obser- 
vation at  time  i.   Equations  (11)  through  (15)  are  the  basic 
equations  of  the  Kalman  filter.   Initial  requirements  for 

the  filter  are  X  ,  C  ,  and  the  variances  of  U  and  W. 

o'   o* 

Although  the  Kalman  filter  was  designed  for  linear 
systems  it  can  be  modified  for  use  with  a  nonlinear  system 
as  in  the  case  of  the  SRS.   Typically,  the  state  equations 
and  the  observations  are  nonlinear  and  both  must  be  "linear- 
ized" by  making  linear  approximations  of  the  equations  to 
use  in  the  filter.   Such  a  method  is  referred  to  as  the  ex- 
tended Kalman  filter.   The  extended  Kalman  filter  equations 
are  analogous  to  the  linear  model  equations  [8].   Since  the 


SRS  utilizes  linear  state  equations,  the  equations  are 
extended  to  include  only  nonlinear  observations.   The  state 
equation  is 

The  gaussian  process  U.  ,  was  omitted  from  eq.  (l6)  to 
facilitate  later  development.   The  omission  is  equivalent 
to  assuming  that  the  actual  system  has  been  modeled  error 
free.   The  observation  is 

Z^  =  h(X^)  +  W^  (17) 

where  h(.)  is  a  nonlinear  function  of  the  state  variables. 
The  estimate  of  the  state  at  time  i  is 

X^  =  X.  +  K.[Z.  -  h(X.)]  (18) 

The  gain  matrix  is 

\   =  CiD,^[D^£^D^T  +  V„^]''  (19) 

where  D.  is  a  nxp  matrix  of  the  partial  derivatives  of  h(«), 

with  respect  to  the  state  variables,  evaluated  at  X.  =  X.  ■ 
also, 

^1  =  *i, 1-/1-1*1,1-1  (20) 

^1-1  =  Ci_,  -  K,.,D^_,5,_,   .  (21) 
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The  approximations  used  in  the  extended  Kalman  filter 
can  lead  to  unsatisfactory  solutions  due  to  divergence. 
Divergence  occurs  when  C,  ,  the  covariance  matrix  of  the 
state  variables,  approaches  zero.   This  results  in  the 
weighting  factors  becoming  unjustifiably  small  causing  the 
incoming  data  to  be  weighted  too  little  [7].   Thus,  the 
solution  becomes  dominated  by  the  time  propagation  of  the 
state  equations.   One  source  of  divergence  is  system  equa- 
tions that  do  not  properly  model  the  physical  system.   This 
situation  can  occur  if  the  linear  approximations  implicit 
in  eq.  (19)  are  not  adequate  in  describing  the  nonlinear 
system.   These  approximations  are  analogous  to  discarding 
all  the  second  degree  and  higher  terms  in  a  Taylor's  series 
expansion  of  the  nonlinear  equations.   Several  approaches 
to  shaping  the  state  covariance  matrix  to  avoid  filter 
divergence  are  discussed  in  [7]. 
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III.  SONOBUOY  REFERENCE  SYSTEM 

The  SRS  was  designed  to  periodically  update  the  posi- 
tion of  the  sonobuoys  based  on  information  received  over  an 
antenna  system.   Figure  1  shows  the  location  of  the  antennas 
These  antennas  provide  three  possible  observations  on  the 
sonobuoy. 

1.  Longitudinal  direction  cosine. 

2.  Transverse  direction  cosine. 

3.  Range  from  aircraft  to  buoy. 

Range  information  is  available  in  limited  conditions.   The 
normal  mode  of  operation  is  with  azimuth  information.   The 
azimuth  measurements  are  calculated  from  the  phase  differ- 
ence of  the  sonobuoy  radio  signals  measured  between  the  ends 
of  antenna  pairs.   The  antennas,  with  the  shortest  spacings, 
are  used  to  give  the  general  relative  bearing  to  the  buoy. 
Once  this  has  been  determined  the  computer  selects  a  pair 
of  antennas  that  are  further  apart  and  refines  the  bearing. 
This  is  a  repetitive  process  which  continues  until  the  anten- 
na pair  is  separated  as  far  as  possible.   Antennas  are  loca- 
ted on  the  top  of  the  fuselage  and  in  the  vertical  tail  to 
allow  buoy  signals  to  be  received  while  the  aircraft  is 
banked  in  a  turn. 

During  normal  operation,  the  SRS  sequentially  checks 
each  of  the  l6  VHF  channels  to  determine  if  any  signals  are 
being  received.   If  no  signals  are  being  received  on  a 
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channel  that  has  a  buoy  assigned  to  it,  the  buoy  location 
and  the  uncertainty  of  its  location  is  updated  by  propaga- 
ting the  last  estimate.   Should  the  aircraft  be  within  re- 
ceiving range  of  two  or  more  buoys  on  the  same  VHP  channel, 
no  data  are  processed.   When  the  SRS  determines  that  a  sig- 
nal can  be  processed  for  information,  the  direction  cosine 
is  calculated  and  a  command  is  sent  to  the  aircraft  naviga- 
tion system  to  determine  the  orientation  and  position  of 
the  aircraft.   This  information  is  passed  to  the  filter, 
processed  and  then  displayed  to  the  crewmen  on  a  cathode 
ray  tube. 


1^1 


IV.  KALMAN  FILTER  FOR  THE  SRS 

The  mathematical  formulation  of  the  problem  utilizes 
two  coordinate  systems,  the  local  and  the  aircraft  system. 
The  local  coordinate  system  is  a  three-dimensional,  right- 
handed  system  with  the  x-axis  pointing  eastward,  the  X-Y 
plane  target  to  the  surface  of  the  earth  and  the  origin 
arbitrarily  fixed.   The  aircraft  attitude  coordinate  system 
is  used  to  reference  the  aircraft  orientation  in  roll, 
pitch  and  heading.   The  aircraft  attitude  can  be  transformed 
into  local  coordinate  values  through  a  rotation  matrix. 

The  state  equations  for  the  system  are  based  on  the 
local  coordinate  system.   The  model  of  the  buoy  motion  used 
in  the  SRS  is 


x^  .T  =  X,  +  X.  dt  (22) 

i+1    i    1 


^i+l  =  yi  +  ^i  ^t  (23) 


^i+1  =  ^i  (24) 


^i+1  =  ^i  (25) 


where  dt  is  the  time  lapse  between  observations.   In  matrix 
notation  they  can  be  expressed  as 


\*1   =  «i  (26) 
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■^ 


where 


X,  =     ^   \  (27) 


1 


X. 

1 


^1 


and 


$=01   0  dt  (28) 


1 

0 

dt 

0 

0 

1 

0 

dt 

0 

0 

1 

0 

0 

0 

0 

1 

The  subscript  on  the  transition  matrix,  $,  has  been  sup- 
pressed since  it  is  not  changing  with  time.   Also,  the  buoy 
motion  as  indicated  by  eqs.  (22)  thru  (25)  lies  in  a  plane 
parallel  to  the  X-Y  plane  of  the  local  coordinate  system. 
This  does  not  imply  that  the  curvature  of  the  earth  is  not 
taken  into  account  only  that  buoy  motion  in  the  Z-direction 
is  negligible. 

The  observation,  Z,  would  be  a  3x1  vector  assuming  the 
three  possible  observations  were  available  simultaneously. 
This  would  require  excessive  computer  time  to  invert  the 
resulting  3x3  matrix  in  eq.  (19)  for  calculating  the  gain 
matrix.   The  SRS  uses  a  sequential  updating  method  to  avoid 
this  problem.   Whenever  multiple  observations  are  available, 
they  are  processed  independently  thereby  reducing  W  and  Z 
to  scalars.   The  observation  for  the  direction  cosine  input 

^^        Z^  =  cos  e.  +  W^  (29) 
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where  W.  is  assumed  to  meet  the  requirements  of  the  gaussian 
noise  in  eq.  (5).   The  observation  is  related  to  the  state 
variables  through  the  geometry  in  figure  2. 


^^a^^a^ 


(^b'^b^ 


Figure  2 
e,  is  the  aircraft  heading,  (x  ,y  )  are  the  coordinates  of 
the  aircraft  position  and  (x,  ,y,  )  are  the  coordinates  of 
the  sonobuoy.   Cos  e  can  be  expressed  as 


cos  e  =  cos  (e,  -  4)) 


(30) 


and  since 


cos  (J)  = 


sin  4)  = 


R 


X,  -X 

b   a 


R 


(31) 
(32) 


where     R  =  [(x^-x^)^  +  (y^-y^)^]^^^ 


(33) 
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it  follows  that 


cos  6.  =  ^^^  ^^      ^°^' ^hi  ^  R  ^^"  ^hi •  ^3^^ 


Since  R.  is  nonlinear  in  the  state  variables  x,  and  y, 
1  b     ''b 

and  considering  0,  .,  x  .,  and  y  .  as  known  quantities,  the 

lid.       ai       ai 

observation  can  be  expressed  as  in  eq.  (17) 


Z.  =  h(x. ,y. )  +  W. 


(35) 


where  x.  and  y.  refer  to  the  buoy  coordinates  at  time  i. 
The  Kalman  filter  equations  are  given  by  equations 
(16)  thru  (21)  with  <t'T^  =  "I*  for  all  k.   The  state  variables 
covariance  matrix  would  be 


C  = 


/c(l) 
'c(2) 


\ 


c(2)  c(3) 

c(5)  c(6) 

c(3)   c(6)  c(8) 

c(4)   c(7)  c(9) 


c(4)  \ 
c(7) 
c(9) 
c(10) 


(36) 


where     c(l)  =  Var  [x] 

c(5)  =  Var  [y] 

c(8)  =  Var  [x] 

c(10)=  Var  [5^] 


(37) 
(38) 
(39) 
(^0) 


and  the  remaining  elements  are  the  respective  covariances, 
e.g. 


c(6)  =  Cov  [y,x]. 


(41) 
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However,  since  the  modeled  system  has  no  uncertainty  built 
into  it  some  method  must  be  used  to  prevent  divergence. 
To  insure  that  C  would  not  become  too  small  c(8)  and  c(10) 
are  replaced  by  Var  [x]  +  (dAdt)^  and  Var  [y]  +  (dAdt)^ 

prior  to  the  propagation  of  the  C  matrix  in  time.   The 

2 
value  of  dA  is  parameterized  at  .002  ft/sec   and  it  repre- 
sents an  acceleration  uncertainty  [9].   Examination  of 
eq.  (3^)  reveals  that  the  partial  derivatives  with  respect 
to  the  velocity  state  vectors  will  be  zero.   Accordingly, 


D  =  (h   h   0   0)  (42) 

X  y 

h  and  h  are  derived  in  Appendix  B. 
X      y  ^^ 

The  required  initial  values  for  aircraft  launched 
buoys  are: 

1.  State  Vector.   Coordinates  are  the  aircraft  drop 
coordinates  and  the  component  velocities  are 
zero  unless  additional  information  is  known. 

2.  Covariance .   Off  diagonal  elements  are  zero. 
c(l)  and  c(5)  are  H  where  H  is  the  altitude  of 

the  aircraft  in  nautical  miles.   c(8)  and  c(10) 

2 
are  (5  knots)  . 

3.  Measurement  variance.   This  quantity  depends  upon 

which  sector  relative  to  the  aircraft  the  buoy 

2 
is  located,  W  =  (1/3.6)   except  when  the  buoy  is 

within  35   of  either  side  of  the  rear  longitu- 
dinal line  when  W  =  (1/2.4)^. 
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V.   SUITABILITY  OF  THE  KALMAN  FILTER  FOR  THE  SRS 

There  are  two  requirements  for  a  filter  used  in  real- 
time data  processing.   First,  the  storage  and  computational 
demands  on  the  computer  must  be  attainable  and  second,  the 
accuracy  requirements  of  the  problem  must  be  met  or  exceeded. 
The  computer  demands  of  a  Kalman  filter  are  high  when  com- 
pared to  other  methods  [10];  however,  the  SRS  uses  several 
techniques  to  reduce  this  demand.   These  techniques  are 
directly  related  to  the  accuracy  of  the  filter.   Although  the 
Kalman  filter  is  optimal  for  a  linear  system,  there  is  no 
guarantee  that  the  real  situation  is  modeled  correctly. 
The  errors  introduced  in  modeling  or  in  simplifying  calcu- 
lations may  result  in  marginal  or  unsatisfactory  filter 
performance.   An  important  result  of  the  Kalman  filter  for 
computer  programming  is  that  all  the  information  from 

Z  ,  Z, Z.  ,  is  contained  in  X.  -,  eliminating  the  need 

o'   1  1-1  1-1  ^ 

to  store  the  old  observations.   In  addition,  the  recursive 
nature  of  the  equations  make  them  readily  adaptable  for  use 
in  a  computer.   The  basic  steps  in  programming  the  filter 
are : 

1.  Initialize  X,  C,  and  W. 

2.  Extrapolate  C  (eq.  20). 

3.  Compute  weighting  coefficients  (eq.  19). 

k.      Obtain  measurement  and  estimate  the  state  vector 
(eqs.  17  and  12). 
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5.  Update  C  to  reflect  the  last  estimate  (eq.  21). 

6.  Return  to  step  2. 

Kalman ' s  assumptions,  of  a  linear  system  with  additive 
gaussian  noise,  are  approximated  by  the  SRS.   The  nonlinear 
observation  has  been  discussed  previously.   The  gaussian 
distributed  bearing  error  assumption  may  be  significantly 
violated  for  certain  flight  conditions.   Whenever  the  line 
of  sight  between  the  aircraft  and  sonobuoy  does  not  change 
significantly  as  compared  to  the  data  rate,  the  bearing 
errors  may  become  biased  due  to  multipath  effects.   Multi- 
pathing  is  caused  by  the  radio  signal  reflecting  off  the 
aircraft  surfaces  prior  to  reaching  an  antenna.   This  re- 
sults in  an  apparent  new  position  for  the  sonobuoy.   Such 
errors  would  not  be  gaussian  distributed  and  would  not  be 
compensated  for  by  the  filter.   In  an  effort  to  reduce  the 
biasing,  a  1/7  scale  model  was  used  to  empirically  determine 
constants  to  apply  to  the  observations.   When  the  SRS  deter- 
mines what  sector  the  sonobuoy  lies  in  relative  to  the 
aircraft,  the  multipath  constant  for  that  sector  is  added 
to  the  observation  to  remove  some  of  the  biasing.   Whether 
the  constants  from  the  scale  model  will  be  sufficient  or 
whether  constants  for  each  aircraft  will  need  to  be  deter- 
mined will  have  to  be  decided  after  the  SRS  is  flight  tested 
in  early  1973- 
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APPENDIX  A 
DERIVATION  OF  GAIN  MATRIX  COMPONENTS 

The  components  of  the  gain  matrix,  K. ,  are  calculated 
directly  from  the  principle  of  minimum  mean  square  error. 
Scalar  equations  are  used  instead  of  matrix  equations  to 
facilitate  gaining  insight  into  the  various  relationships 
and  to  emphasize  the  approximations.   Only  one  weighting 
constant  is  derived;  however,  the  remaining  constants  can  be 
obtained  in  a  similar  manner. 

The  equation,  for  the  smoothed  estimate  of  the  x-coordinate 
of  the  buoy,  is 


X 


i+i  =  ^i+1  ■"  ^ii^^i+1  -  h^^i+i^yi+i^^  ^Ai) 


k,  .  is  to  be  calculated  so  that 

E[(x.^^  -  x^^^)^]  (A2) 

is  a  minimum. 
Now 


^i+1  -  ^i+1  =  ^i+l  -^  ^lil^^i+l-h^^i+l'^i+l^^  -  ^i+1 
=  X.  +  I.dt  +  k^.[h(x.^^,y.^-L)+w.^^ 
-h(Xj^+x^dt,y^+y^dt)]  -  x^  -  x^dt 


let 


(A3) 


e^   =  X.  -  X.       and     e^   =  x.  -  x.    (A4),(A5) 
x^     X     1  X.     1     1 
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substitution  into  eq.  (A3)  yields 


'^i+1  ^  '^i"*"  '^i^^^  "^  ^ii^^^^i^v^>yi-*-^i^^^-*-^i+i 


-h(x^+r^dt,y^+y^dt)]  ,  (A6) 

in  addition  , 

h(x.+x  dt,y  +y  dt)  =  h(x  -e   +(x  -e   )dt,y.-e^  +(y1-^.  )dt) 
-L  X  i       i        ^i      "^i 

=  h(x.+x.dt-e   -e   dt,y.+y.dt-e   -e   dt )  (A?) 

^  1   i    ^i   ^1   ^  ^    ^i   ^i 


Using  Taylor  series  expansion  about  the  i   smooth 
estimate,  the  expression  for  h(*,*)  can  be  approximated  by 


h(x.+idt,y.+ydt)  +  h^(x. +x. dt ,y . +y .dt ) (-e^  -e   dt ) 

+  h  (x.+xdt,y.+y,dt)(-c   -e   dt )  (A8) 


where 


\('r)    =  ^^Vx'^    ^^^    hy(-,-)  =  ^^V/'^        (A9),(A10) 


Since  the  arguments  for  h(",')  do  not  change  and  for  ease  of 
manipulation,  the  arguments  of  h(«,')  are  suppressed  and 
equation  (a8)  becomes 

h  +  h^(-e^  -G^  dt)  +  h  (-e   -e   dt )  (All) 

X    Xj^   x^        y    y^   y^ 
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Substituting  eq. (All)  into  (A6)  and  squaring  both  sides 
yields 


e^     =  e^   +  e^  dt^  +  k?.[   ]  +  2e   e   dt  +  2e   k, . [  ' ] 
^i+1     ^i     ^i        1^         ^i  ^i       ^i  1^ 


+  2e^_dt  k^^[   ]  (A12) 


where 


[   ]  =  w?^,  +  (e   +e   dt)^h   +  (e   +e   dt)^h^ 


-    2w 


..,  (e   +e   dt)h   -  2w._l,  (e   +e   dt)h 

1+1'  Xj_    Xj_    '  X        i+1'  YjL    yi       y 


+  2(e   +e   dt)h   (e   +e   dt)h    .  (A13) 

'  x^   x^   '  X  '  y^   y^  .  '  y 


Taking  the  expected  value  and  defining 


o^    =  E[e^  ]  a?  =  E[e^  ] 

X.      X.  x^      X. 


^xx.=  ^^^x.^x,^  ^'  =  ^^^i+1^ 


E[w.^,]  =  E[w._,,e   ]  =  E[w.^,e   ]  =  0 
1+1         1+1  X.         1+1  X. 


(Alii) 

thru 

(A20) 


2i\ 


with  similar  expression  for  the  y-quantities  yields 

a^     =  0^   +  a^  dt^  +  k?.[a^+(a^  +2a^-  dt+a?  dt^)h^ 
^i+1    ^i    ^i  ^i   ^^i    ^i     ^ 


+  (a^  +2a^-  dt+a?  dt^)h^  +  2(a^   +a?   dt+o^-  dt 


^i   y^i    yj_     y      xy^   xy^    xy^^ 


+  a?-  dt^)h  h  ]  +  2a^-  dt  -  2k, .h  (a^  +a^-  dt ) 
xy^^    '  x  y-"     XX.       li  X  x.   XX. 


-  2k, .h  (a^  +0^'    dt)  -  2k, .h  dt(a^-  +a?  dt) 
li  y   xy^   xy^        li  X   ^  xXj_   x^ 


-  2k-,. h  dt(a?   +a?-  dt ) .  (A21) 

li  y    xyj_   xy^ 


Solving  eq.  (A21)  for  the  k, .  which  minimizes  a     using 

^i+1 
standard  calculus  techniques  results  in 


\^4.^^4k.^^^4.^^^^   ^  N^^xy,^^xy.^^^4y/^^4y.^^'^ 
^li  - 

(A22) 


where 

B  =  a^  +  h  ^(a^  +2o^ -    dt+a?  dt^)  +  2h  h  (a^   +a?   dt+a^-  dt 
x   x^        xx^    x^         X  y'  xy^  xy^    xy^  ^ 


+a--  dt^)  +  h  ^(a^  +2a^-  dt+a?  dt^).  (A23) 

xy^   '    y  '  y^      yy^        y^ 
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Similar  results  are  obtained  if  the  following  matrices  are 
substituted  into  eq.  (19)  and  expanded: 


C.  = 

1 


2  ^ 


.2. 

yy^^ 


XX. 


xy. 


X. 

2^ 
xy. 


(A24) 


D.  =  (h  h   0   0) 
1     X   y 


(A25) 


W.  =  a' 


(A26) 
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APPENDIX  B 
DERIVATION  OF  PARTIAL  DERIVATIVES 

Figure  Bl  illustrates  the  geometry  for  the  derivation 
of  the  partial  derivatives  of  the  measurement,  cos  e. 


A/C 


S/B 


FIGURE  Bl 


P,  is  the  vector  from  the  aircraft  to  the  sonobuoy. 

P.  is  the  vector  representing  the  antenna  pair  making  the 

observation. 


^K  =  (x,  -x^)i  +  (y,  -y^)j 


'b  ^a 


b  -^a 


K  =  (x,  -X.  )i  +  (y  -y   )j 
t     t^    ^2       t^  t^ 


(Bl) 
(B2) 


The  corresponding  unit  vectors  are 

X,  -X   ,     y  -y   . 
^b      R    ^       R   '^ 


(B3) 
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X.  -X        y  -y 

P  =  — = i   +  — = =•  1 


(B^) 


where 


R=  [(x,-x^)^+  (Vb-^a^'^ 


1/2 


(B5) 


and  k,  is  the  length  of  the  antenna  pair. 

/x,  -X 

/ 


Hence, 


h  "^2 


cos  e  =  P,  'P,  = 

t   D 


'^b-^a     ^b-y. 


\ 


R 


R 


^t  "^t 
^1   ^2 


(B6) 


Let 


\  "^t 
^1   ^2 

k^ 


and 


^2  = 


^t  "^t 
^1   ^2 

k^ 


(B7),(B8) 


then 


cos  e  =  c.  -At-^  +   c,   "^   ^ 


'1   R 


2        R 


(B9) 


Differentiating  with  respect  to  the  state  variables  yields 


a(cos  e) 
3x^ 


^   r  "l^^b-^a^  -^  "2^yb-ya^  -,  IR 
R  ~  •-  j^2  -J  8x^ 


(BIO) 


since , 


9R 
'Bx^ 


X,  -x 
b   a 

R 


(BID 


8(cos  e)  ^  _\_ 

9X^         R 


-  cos 


r2 


(B12) 
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% 


simllarlyj 


i(c£|_e)  ._     ^  .  ,,3  e  ^  .  (B13) 


In  matrix  notation > 


b        iPbl 


29 


LIST  OF  REFERENCES 


1.  Parzen,  E.,  Stochastic  Processes ^  Holden  Day,  1962. 

2.  GausSj  K.  G. ,  Theory  of  Motion  of  the  Heavenly  Bodies 
Moving  about  the  Sun  In  Conic  Sections,  p.  2  60,  Dover 
Publications ,  Inc . ,  1963. 

3.  Fisher,  R.  A.,  "On  an  absolute  criterion  for  fitting 
frequency  curves,"  Messenger  of  Math,  vol.  4l,  1912. 

H.      Kolmogorov,  A.N.,  "Interpolation  and  extrapolation  of 
stationary  random  sequences,"  translated  by  W.  Doyle 
and  J.  Selin,  Rept.  RM-3090-PR,  RAND  Corp.,  Santa 
Monica,  Ca. ,  1962. 

5.  Wiener,  N. ,  The  Extrapolation,  Interpolation  and  Smoothing 
of  Stationary  Time  Series,  Wiley,  19^9 • 

6.  Kalman,  R.  E.,  "A  new  approach  to  linear  filtering  and 
prediction  problems,"  J .  Basic  Eng. ,  vol.  82,  Mar.  i960. 

7.  Fitzgerald,  R.  J.,  "Divergence  of  the  Kalman  Filter," 
IEEE  Transactions  on  Automatic  Control,  vol.  AC-I6,  No.  6, 
pp.  736-747,  Dec.  1971. 

8.  Kappl,  J.  J.,  "Nonlinear  estimation  via  Kalman  Filtering," 
IEEE  Transactions  on  Aerospace  and  Electronic  Systems, 
vol.  AES-7,  no.  1,  pp.  79-B4,  Jan.  1971. 

9.  SRS  Data  Processing  Development,  PD/513-1,  Cubic  Corp., 
5  Oct.  1970. 

10.   Behnke,  K.  W.  and  Singer,  R.  A.,  "Real-Time  Tracking 

Filter  Evaluation  and  Selection  for  Tactical  Applications," 
IEEE  Transactions  on  Aerospace  and  Electronic  Systems, 
vol.  AES-7,  no.  1,  pp.  100-110,  Jan.  1971. 


30 


INITIAL  DISTRIBUTION  LIST 


No.  Copies 


1.  Defense  Documentation  Center  2 
Cameron  Station 

Alexandria,  Virginia   2231^ 

2.  Library,  Code  0212  2 
Naval  Postgraduate  School 

Monterey,  California   939^0 

3.  Chief  of  Naval  Personnel  1 
Pers  -  lib 

Department  of  the  Navy 
Washington,  D.C.   20370 

^.   Naval  Postgraduate  School  1 

Department  of  Operations  Research 

and  Administrative  Sciences 
Monterey,  California  939^0 

5.  Assoc.  Professor  T.  D.  Burnett,  Code  55Za  1 
Department  of  Operations  Research 

and  Administrative  Sciences 
Naval  Postgraduate  School 
Monterey,  California   939^0 

6.  Assoc.  Professor  R.  N.  Forrest,  Code  55Fo  1 
Department  of  Operations  Research 

and  Administrative  Sciences 
Naval  Postgraduate  School 
Monterey,  California  939^0 

7.  Mr.  R.  G.  Hemann  1 
Dept.  7935 

Lockheed  California  Company 

P.O.  Box  551 

Burbank,  California   91503 

8.  LCDR  S.  D.  Stair  1 
1872  Ithaca  Street 

Chula  Vista,  California   92010 


31 


Spcvintv  Classification 


DOCUMENT  CONTROL  DATA  -R&D 


Security  classiticalion  ol  lllle,    body  of  ttbsliiict  and  indexing  annotation  niust  be  entered  when   the  overall  report  Is   classified) 


ORIGINATING    ACTIVITY  (Corporate  author) 

Naval  Postgraduate  School 
Monterey,  California   939^0 


2«.   REPORT    SECURITY    C  L  A  SSI  F  I  C  A  T  I  Or 


Unclassified 


2^.  CROUP 


3   REPORT  TITLE 


The  Application  of  the  Kalman  Filter  to  the  Sonobuoy  Reference 
System  on  the  S3A 


4.    DESCRIPTIVE   NOTES  (Type  of  report  and,inclusive  dates) 

Master's  Thesis;  September  1972 


S     AUT>^OR{S)  (First  name,  rrtiddle  initial,  last  narre) 


Sammy  Dean  Stair 


6      REPORT    DATE 


September  1972 


7«.     TOTAL    NO.    OF    PAGES 


33 


76.    NO.    OF    REFS 


10 


««.    CONTRACT    OR    GRANT    NO. 


b.    PROJEC  T  NO. 


9a.    ORIGINATOR'S    REPORT    NUMeER(S) 


»b.  OTHER   REPORT  NO(S)  (Any  Other  numbera  that  may  be  aaalgned 
Ihl*  report) 


10.    DISTRIBUTION    STATEMENT 


Approved  for  public  release;  distribution  unlimited 


11.    SUPPLEMENTARY    NOTES 


12.    SPONSORING    MILITARY    ACTIVITY 


Naval  Postgraduate  School 
Monterey,  California   939^0 


13.  ABSTR  AC  T 


In  i960  R.  E.  Kalman  introduced  a  least  square  concept  that 
gives  optimal  estimates  for  the  state  of  some  dynamic  systems. 
Included  is  a  brief  historical  introduction  leading  to  his  work, 
a  summary  of  his  work,  and  the  application  of  the  theory  to  the 
sonobuoy  reference  system  used  on  the  S3A  aircraft.   Also,  a 
tutorial  development  of  certain  quantities  used  in  the  filter  is 
presented  in  appendices  A  and  B. 


DD/r:..1473     ""^"^^  " 

S/N  0101 -807-681  1 


32 


Security  Classification 


A-31406 


Security  Classification 


KEY     WO  R  DS 


Kalman  filter 

Sonobuoy  Reference  System 

S3A 

Filter  divergence 


DD  /r:..1473 

S/N     0101-807-6921 


BACK 


33 


Security  Classification 


A- 3 1 409 


138455 

Thesis 

ff     '"''The  application  of   the 
r-  Kalman  filter  to  the  so 

nob^y  reference  system 

on   the  S3A.       (^  \  ""  3  ^i  ^ 
026  13 


-  3  "-^  t  P  ''  S 
23  IJ>R   86 


3  OU  U*' 


V^'l'   ...  1^8455 

S6715       Stair 

c.l  The  application  of   the 

Kalman   filter    to   the   so- 
nobuoy   reference  system 
on    the  S3A. 


thesS67l5 

The  a 


3  2768  00100779  2 

DUDLEY  KNOX  LIBRARY 


